#include "robot_manager.h"

int main(int argc, char **argv)
{
    ros::init(argc, argv, "zoros_node");
    ros::NodeHandle nh("~"); // 使用私有命名空间

    // ros::Timer timer = nh.createTimer(ros::Duration(CONTROL_FREQ), publishJointStatesLoop);

    RobotManager manager(nh);
    ros::Duration(2.0).sleep();
    manager.start();
    ros::spin();
    return 0;
}